(12) 



UK Patent Application GB «», 2 227 106-A' 



(43) Date of A publication 18.07.1990 



(21) Application No 8925634.1 

(22) Date of filing 13.11.1989 



(30) Priority data 
(31) 63286347 
01274748 



(32) 12.11.1988 
21.10.1989 



(33) JP 



(71) Applicant 

Kabushik! Kaisha Toyota Chuo Kenkyusho 

(Incorporated In Japan) 

41*1 Aza Yokomlchl, Oaza Nagakute, Nagakute-cho, 
Alchl-gun, Aichl-ken 480-11, Japan 

(72) Inventors 

Maseru Nakano 
Minoru Tanaka 
Toshltaka Kuno 

(74) Agent and/or Address for Service 
Kilburn and Strode 

30 John Street, London, WC1N 2DD, United Kingdom 



(51) INT CL* 

G05B 19/405 23/02 

(52) UK CL (Edition K) 

C3N NGBC6 N273 N376 N383B 
U1S S1881 

(56) Documents cited 
EP 0268317 A 

(58) Field of search 

UK CL (Edition J) G3N NGB 
INT CL 4 G05B 



(54) Detecting collision 

(57) The risk of collision between objects (eg involving robots or unmanned cars) is determined by representing the surface 
of each object by spheres 14, 15, 16 arranged in a hierarchy of ranks from the largest which encloses the object to the 
smallest, spheres in a given rank all being of the same size, and checking whether at increments of relative movement of 
the objects, any sphere of one object intersects a sphere of another. The checking starts with the largest spheres and 
progesses rank by rank to the smallest spheres via the spheres which are found to intersect, collision being held to have 
been detected when two of the smallest spheres intersect. 
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APPARATUS FOR DETECTING THE COLLISION OF MOVING OBJECTS 



BACKGROUND OF THE INVENTION 
Field of the Invention: 

The present invention relates to an apparatus for 
rapidly detecting collision of moving objects with high 
accuracy , and is applicable to, f<?r instance, a system 
for confirming the safety of motion of a taught robot 
by means of a graphic simulator or the like, a system 
for determining the risk of collision in the motion of 
a robot in real time, a system for determinging the 
risk of collision of an unmanned car in real time, or 
other similar system. 

Statement of the Related Art: 

Conventionally, in the determination of the risk 
of collision of a robot, for instance, a graphic 
simulator is used which is adapted to display on a 
screen the configuration of a robot at various 
positions in a path of its movement or continuously 
display the motion of a programmed robot on a screen. 
In this apparatus, the continuous motion of a robot is 
displayed at an actual moving speed and its motion is 
simulated, and it is necessary to detect rapidly the 
risk of collision between two moving robot arms and 
between the robot arm and a stationary object with high 
accuracy. 
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Various types of methods are known for determining 
the risk of collision. 

For instance , in a first method, as disclosed in 
Japanese Patent Laid-Open No. 43706/1987, the members 
of a robot and the work environment are covered with 
polyhedrons, and the presence of a collision is 
determined from projected figures of the polyhedrons. 
In a second method, as disclosed in Japanese Patent 
Laid-Open No. 99591/1975, the members of a robot and 
the work environment are expressed by line segments, 
and the distance between the line segments is computed 
to determine the presence of a collision. In a third 
method, as disclosed in the Journal of Robotics Society 
of Japan, Vol. 6, No. 1, p. 35, the position of 
movement of a robot or an object in the environment is 
expressed as a function of time, and the collision 
between a vertex and a plane or between two edges is 
determined to be a collision on the basis of that 
function. 

In addition, as disclosed in the Journal of 
Robotics Society of Japan, Vol. 5, No. 3, p. 21, a 
fourth method is known in which a robot and an object 
in the environment are approximated hierarchically by 
cubes having different sizes, and a collision is 
determined by checking the relationship of inclusion of 
the cubes of the two objects. Furthermore, as 
disclosed in a collection of papers for the 6th Annual 
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Conference of Robotics Society of Japan, p. 105, a 
fifth method is known in which a robot and an object in 
the environment are approximated hierarchically by 
spheres having different radii , and the relationship of 
inclusion of the spheres having different radii is 
checked so as to determine the collision of an object. 

However, the following drawbacks are experienced 
with the above-described conventional methods. For 
instance, with the aforementioned first method, it is 
impossible to effect collision detection with high 
accuracy in cases where a member is a concave cube and 
it is therefore difficult to approximate its shape with 
a mere cylinder or rectangular parallelepiped. With 
the second method, although rapid determination is 
possible, modelling is too simple so that the accuracy 
of collision determination is not good. With the third 
method, the amount of computation required becomes 
large as the number of faces increases, resulting in an 
extreme slowing down in the processing speed. 

In addition, the fourth method has a problem in 
that although it is based on the technique of a 
hierarchical structure using a so called octo-tree, 
since an approximation to a cube is required, the 
coordinate conversion for expressing a continuosly 
moving object is complicated and takes time. 
Furthermore, in accordance with 



the fifth method, a robot and an object in the environment 
are approximated hierarchically by spheres having different 
radii so as to simplify the coordinate conversion. As for 
the method of generating a sphere in a lower rank, however, 
a regular polyhedron inscribing an upper rank is first 
determined and the sphere is then determined as one which 
circumscribes the faces constituting the regular polyhedron 
and whose center corresponds to the center of gravity of 
that polyhedron, so that there has been a drawback in that 
the mechanism of generating the spheres in the lower rank 
becomes complicated and modeling takes time. Also, there is 
an additional drawback in that the modeling efficiency is 
poor and hence modeling takes time due to such causes as an 
increased number of overlapping areas between spheres, the 
occurrence of a lower- rank sphere which includes an outer 
portion of an upper- rank sphere, and the occurrence of a 
case in which the same sphere belongs to two different 
upper- rank spheres, or a sphere belongs to a sphere located 
in an immediately higher rank but does not belong to a 
sphere located in a rank of a level two ranks higher. 
Furthermore, there is a drawback in that since spheres of a 
hierarchical structure are generated uniformly with respect 
to the interior and exterior of objects that are not 
necessary for describing the shapes of objects 
subject to modeling, .the number of spheres generated becomes 
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numerous, thereby decreasing the modelling efficiency. 
Moreover, although the accuracy depends on the radius 
of the smallest spheres, and the computing speed of 
collision detection depends on the frequency of 
determination of collisions between the spheres, i.e. 
the hierarchical structure of the spheres, since the 
ratio of radius between the spheres in the mutually 
adjacent layers is restricted to a fixed ratio, it is 
difficult to arbitrarily change the hierarchical 
structure and the radius of the smallest spheres. 
Hence, the adjustment of the accuracy and the computing 
speed becomes difficult. 



SUMMARY OF THE INVENTION 

Accordingly, an object of the present invention is 
to provide an apparatus for detecting the collision of 
a moving object which is capable of decreasing the 
frequency of collision determination between spheres 
and rapidly carrying out the determination of the risk 
of collision of an object with excellent accuracy by 
improving the modelling speed of an object and 
simplifying the hierarchical structure of the spheres, 
thereby overcoming the above -described drawbacks of the 
conventional art. 

To this end, in accordance with the present 
invention, as illustrated in Fig. 1 , there is provided 
an apparatus for 



detecting the collision of objects including at 

Xeast one moving object, comprising, face information 

coring means A for storing face information describing the 

surfaces of each of the objects, hierarchical sphere model 

generating means B for modeling the surfaces of each of 

the objects by hierarchically covering the surfaces 

with spheres having a plurality of radii on the basis 

ot the face information, sphere model storing means C for 

storing the positions of the modeled spheres so generated, 

sphere position updating means D for updating 

the position of each of the modeled spheres having the 

plurality of radii with respect to the moving 

object in correspondence with the movement of the moving 

object and outputting the updated position to the 

sphere mode! storing means C, and sphere collision compute 

m eans E for executing procedures in which mutually 

oolliding ones of the spheres are detected on the bas.s of 

the positions of theWeled spheres concerning two of the 

ohjects generated at an arbitrary time and stored in the 

sphere model storing means, and colliding spheres among 

spheres belonging to the mutually colliding spheres end 

* „^ 0 -r detected with respect to 
having a smaller radius are further detec 

only the spheres determined to collide with each other, the 
pr ocedures being executed hierarchically and" consecutively . 
carting with spheres, having a large radius toward spheres 
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having a smaller radius, and for determining the 
collision of the two objects with each other when 
finally mutually colliding spheres having the smallest 
radius are detected to be present. 

The face information storing means A is a means 
for storing information concerning flat and/or curved 
surfaces constituting the surfaces of an object, and is 
a device adapted to store functions of component flat 
and/or curved surfaces. 

The hierarchical sphere model generating means B 
is a means for generating spheres respectively covering 
the surfaces of objects determined on the basis of the 
aforementioned face information, and for generating the 
positions of the spheres. Specifically, the 
hierarchical sphere model generating means B is adapted 
to model an object by covering its surfaces with 
hierarchical spheres by hierarchically covering the 
surfaces of the object with spheres having a 
predetermined number of ranks and predetermined radii. 
This means B may comprise means for determining radii 
of spheres in medium ranks between an uppermost rank 
and a lowermost rank on the basis of a radius of the 
uppermost rank sphere circumscribing the objects and a 
radius of the lowermost rank of smallest spheres which 
determines a predetermined accuracy of collision 
detection, and 
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hierarchically arranging the spheres so that the larger spheres 
include the smaller spheres and the surfaces of the objects. 
Further, radii of spheres in each rank and the number of ranks 
may be determined on the basis of the radius of the uppermost 
rank sphere, the radius of the lowermost rank sphere and 
further a ratio of radius between an upper rank sphere and 

a lower rank sphere. 

The sphere model storing means C is a means for storing 
the positions of the spheres in each rank generated, e.g., 
the central positions and radii thereof. 

The sphere position updating means D is a means for 
updating the positions of the spheres in each rank in 
correspondence with the movement of the object and storing 
the updated data On the positions in the sphere model 
storing means C. For instance, the position and posture of 
an object can be described by the parallel movement and 
rotational movement of a coordinate system fixed to the 
object, and this parallel movement and the rotational 
movement can be expressed by one transformation matrix. 
Accordingly, the central position of each sphere, as viewed 
from its absolute coordinate system, after movement can be 
obtained by multiplying the central position as viewed in 
the coordinate system fixed to each object by the 
aforementioned transformation matrix. 
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The sphere collision computing means E is a means 
for computing the presence of a collision between 
objects and their colliding positions on the basis of 
the positions of the spheres stored in the sphere model 
storing means C at the time when an object moves. More 
specifically, a determination is made as to the 
presence of a collision of a sphere having the largest 
radii between two objects, i.e., the sphere in the 
uppermost layer. For instance, this collision 
determination is made as a result of whether or not the 
distance between the central positions of the two 
spheres is smaller than the sum of the radii of the 
spheres. In addition, when a determination is made 
that no collision exists, a collision determination is 
made between other spheres, e.g. of the same rank. On 
the other hand, if a determination is made that a 
collision exists, a determination of the presence of a 
collision is similarly carried out for a sphere having 
a next smaller radius belonging to that sphere^ i.e., a 
sphere in an immediately lower rank. If a 
determination is made that a collision exists, 
collision determinations are consecutively made with 
respect to spheres in a further lower rank belonging to 
that colliding sphere. On the other hand, when no 
colliding sphere exists among the spheres in a given 
rank, the operation is carried out for a rank which is 
one level higher, and computation for detecting a 
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colliding sphere in that rank is carried out. If a 
colliding sphere is found , a collision determination is 
made for spheres in a further lower rank through the 
above described procedures, and, if no colliding sphere 
is present, the operation is carried out for a further 
higher rank, and computation for detecting a colliding 
sphere is similarly performed. Then, when mutually 
colliding spheres having the smallest radius are 
finally present, it is determined that the two objects 
collide with each other. Further, when necessary, the 
colliding positions of the two objects may be 
determined on the basis of the positions of the 
mutually colliding spheres having the smallest radius. 

According to the present invention, as described 
above, the surfaces of objects are modeled by being 
covered with spheres, while the interior and exterior 
of the objects are excluded from being modeled. 
Therefore, the hierarchical structure of the spheres is 
simplified and the modeling speed of the objects is 
improved due to the reduced number of spheres. As a 
result, the time for computation of a collision 
detection is reduced. 

Since the modeling is conducted by means of 
spheres, the movement of the spheres accompanying the 
movement of the object can be computed merely by 
computing the movement of central positions of the 
spheres , thereby 
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simplifying the computation of updated spheres* 

Further , since the accuracy of collision 
determination depends on the radius of a smallest 
sphere which can be arbitrarily set, the accuracy of 
collision determination can be arbitrarily changed. 

The time for computation can be reduced by 
increasing the number of ranks in a hierarchical 
modeling. 

Furthermore, the speed of collision determination 
is improved, since a collision determination of the 
spheres is hierarchically conducted starting with 
spheres in an upper rank having a high possibility of 
collision toward spheres in a lower rank belonging to 
the colliding spheres. Namely, it is possible to 
efficiently determine a collision generating portion by 
excluding the portions being unlikely to collide during 
the process of rough detection toward fine detection. 

Thus, according to the present invention, it is 
possible to carry out rapidly detection of the risk of 
collision between objects with high accuracy. Namely, 
it is possible to determine the risk of a collision in 
real time between, for example, a moving manipulator of 
a robot and a standing conveyer structure or a moving 
manipulator and another manipulator. Therefore, the 
present invention serves to prevent an accident such as 
a collision between objects or enables the path of a 
moving object to be changed efficiently so as to avoid 
the risk of collision. 

In the present invention, the term "collision 
detection" means to judge which objects collide or may 
collide and at which position objects collide or may 
collide by detecting a degree of approximation between 
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spheres covering surfaces of objects* 

The above and other objects , features and 
advantages of the present invention will become more 
apparent from the following detailed description of the 
invention when read in 
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conjunction with the accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a block diagram illustrating an overall 
structure of the present invention; 

Fig. 2 is a block diagram illustrating a structure 
of an apparatus in accordance with a specific embodiment of 
the present invention; 

Fig. 3 is a flowchart of the procedure of processing by 
a CPU used in the apparatus of the embodiment; 

Figs. 4, 5(a) to 5 (c) and 6(a) to 6(c) are explanatory diagrams 
illustrating the method of generating large spheres, medium 
spheres and small spheres, respectively; 

Figs. 7 and 8 are diagrams illustrating a hierarchical 
structure of a sphere model; 

Figs. 9(a) to 9(e) are explanatory diagrams illustrating 
the logic of collision determination; 

Figs. 10(a) and 10(b) are diagrams illustrating cubic cells 
having overlapping portions and rectangular parallelepiped 
cells with the overlapping portions deleted and spheres 
enveloping them, ' respectively; 

Fig. 11 is an explanatory diagram illustrating 
collision detection between two sphere models having a 
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different number of ranks; and 

Fig. 12 is a flowchart of the procedure of processing 
by a CPU for searching colliding spheres. 

DESCRIPTION OF THE PREFERRED EMBODIMENTS 

Referring now to the accompanying drawings, a 
description will be given of the preferred embodiments of 
the present invention. 
First Embodiment 

Fig. 2 illustrates an apparatus for detecting the 
collision of a moving body in accordance with a first 
embodiment of the present invention in which the collision 
between robots or between a robot and an object is detected 
when data on configurations and positions concerning the 
robot and a work environment is input, and the robot (s) and 
the work environment are displayed on a graphic display so 
as to simulate the motion of the robot (s) . 

As shown in Fig. 2, this apparatus is constituted by a 
computer apparatus comprising the following units: a CPU 1 
for executing logical operations and the like; a ROM 2 in 
which a program. specifying processing procedure thereof is 
stored; a RAM 3 for storing various data; a data input unit 4- 
for inputting positional and geometric model data of a robot 
and a work environment and imparting various commands 
including a simulation start command; a graphic display 5 
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on which the configuration of a robot and the work environment 
which change with time are displayed for each fine sampling 
time; and input/output interfaces 6, 7 for connecting the 
data input unit 4 and the graphic display 5 to the CPU 1. 
In addition, the following are formed in the RAM 3: a 
geometric model data memory 31 for storing information on 
faces, vertices, and edges describing the geometric model of 
each component member of the robot arm and the work 
environment; a sphere model memory 32 for storing 
information concerning the central position and radius of 
each sphere and ranks when the surfaces of the component 
member are converted into a hierarchical 

structure; a joint angle memory 33 for storing the present 
joint coordinates of the robot; and a member position memory 
34 for storing the present position of each component member 
of the robot and the work environment. 

A description will now be given of the operation of 
this apparatus with reference to the flowchart of Fig. 3 
illustrating the processing procedures of the CPU 1. 

In Step 100, data for generating the respective 
geometric models of the component members of the robots and 
the work environments is first input from the data input unit 
4. Through this input, data on the vertices, edges, faces, 
etc., representing the geometric model of each component 
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member is computed. This geometric model data is stored in 
the geometric model data memory 31. 

In Step 102, data concerning restricting relationships of 
the component members of the robots and the work environments 
and their positions and orientations on absolute coordinates 
is input from the data input unit 4. As this data is input, 
the robots and the work environments are adapted to be 
displayed on the graphic display 5 so that the detection of 
input data errors and the inputting of data can be executed 
easily. Then, the data on the positions and restricting 
relationships between the robots and the work environments 
is stored in the member position memory 34. 

Upon completion of the inputting of positional data in 
Step 102, data specifying the robots and the work environments 
which are subject to collision are input by the data input 

unit 4 in Step 104. 

In Step 106, the surfaces of the component members of 
the robots and the work environments specified in Step 10 4 for 
each component member are hierarchically covered with the 
three types of large, medium, and small spheres to effect 
hierarchical sphere modeling of the surfaces. The sphere 
modeling of the surfaces is carried out as follows. 

As shown in Fig. 4, a rectangular parallelepiped -shaped 
envelope 12 enveloping a component member 11 is generated 
from face information data by referring to the geometric model 
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data memory 31 concerning the component m mber 11. 
Furthermore, a sphere circumscribing the envelope 12 is 
conceived, and that sphere is set as a large sphere 14. 
Thus, the large sphere 14 in the uppermost rank is 
generated as a sphere enveloping the component member 
11. Then, the central position and radius of the large 
sphere 14 as viewed from reference coordinates 
concerning the component member 11 are stored in the 
sphere model memory 32. 

Then, as shown in Fig. 5 (a), the envelope 12 is 
divided into a plurality of cubic cells 17 each having 
an edge of m = if~2 rm with respect to a radius rm of a 
medium sphere 15. Since the length of each edge of the 
envelope 12 is not necessarily a multiple of the length 
of the edge of the cell 17, the cells 17 are arranged 
in such a manner as to overlap each other. Then, as 
shown in Fig. 5(b), spheres 20 cicumscribing each cell 
17 are generated, and only those spheres that intersect 
with a surface 13 of the component member 11 are 
extracted from the spheres 20, and these extracted 
spheres are set as medium spheres 15 (see Fig. 5(c)). 
Then, the central positions of the medium spheres 15 as 
viewed from the reference coordinates concerning the 
component member 11 are stored in the sphere model 
memory 32. 

Subsequently, as shown in Fig. 6(a), attention is 
focused on the cells 17 each inscribing the medium 
sphere 15, and 



- 17 - 



each of the cells 17 is divided into cubic cells 18 each 
having an edge of is = fS rs by assuming that the radius of 
a small sphere is rs. At this time, the cells 18 are 
arranged in such a manner as to overlap each other as at the 
time of the generation of the medium spheres. Then, spheres 
21 circumscribing these cells 18 are generated, and only 
those spheres that intersect the surface 13 of the component 
member 11 are extracted, the extracted spheres being set as 

, ' t. <ml r e 7). subsequently, the central 
small spheres 16 (see Figure 7). 

positions of the small spheres 16 as viewed from thel 
reference coordinates concerning the component member 1 1 
are stored in the sphere model memory 32. 

Thus, as shown in Fig. 7, the component member 11 is 
hierarchically modeled by means of the three types of 
spheres having different radii, the large sphere 14 
enveloping the entire body, the medium spheres 15 which are 
smaller than the same and include the surface 13 of the 
component member 11, and the small spheres 16 which are far 
smaller. Namely, it can be appreciated from Fig. 8 that the 
spheres are formed into a hierarchical structure in the form 
of a tree in which all the small spheres belong to any one 
of the medium spheres, and all the medium spheres belong to 

the large sphere. 

The radius rs of the small sphere 16 is set arbitrarily 
by taking the accuracy of collision determination into 
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consideration. Then, the radius rm of the medium sphere 15 
can be determined automatically from the following formula 
on the basis of the radius r| of the large sphere and the 
radius rs of the small sphere: 



rm=\TrT 7 rs 

According to this formula, it is possible to equalize the 
ratios of volume between the small sphere and the medium 
sphere and between the medium sphere and the large sphere. 
As a result, it is possible to obtain a hierarchical 
structure having good efficiency in retrieval at the time of 
collision determination. 

in addition, as an exception, in a case where the radius 
of the large sphere 14 is smaller than the given radius of a 
small sphere 16 due to the fact that the outer dimensions of 
the component member 11 are small, the generation of the 
small spheres 16 are not effected, and the modeling is 
carried out with the large spheres 14 alone. 

When the hierarchical sphere modeling for the 
respective component members is completed as described 
above, the process proceeds to Step 108 to input a motion 
command for the robot from the data input unit 4. Then, the 
operation proceeds to Step 110 in which joint coordinates of 
the robot after fine movement, i.e., a joint angle, is 
computed in correspondence with a fine movement- motion 
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concerning an interpolation point. The joint angle data is 
stored in the joint angle memory 33. Subsequently, upon, 
completion of the computation of the joint angle, the 
operation proceeds to Step 112 in which a transformation 
matrix T, which allows the reference coordinate system and the 
absolute coordinate system concerning each component member to 
be related to each other, is computed on the basis of the joint 
angle at that time. The transformation matrix T is one in 
which the position and the orientation as viewed from the 
absolute coordinates of the reference coordinates concerning 
each component member composing the robot or the work environment 
are expressed by a matrix of 3 x 4. Then, if it is assumed 
that a vector describing the central position of each sphere 
as viewed from the reference coordinates concerning each 
component member is Pref the vector Pabs describing the 
central position of each sphere as viewed from the absolute 
coordinates can be determined on the basis of the following 
formula: 



' Pabs v 




' P rejT 




= T x 




, • 1/ 




v 1 > 



With respect to an object such as a robot whose component 
members move, it is necessary to calculate the 
transformation matrix T on the basis of each joint angle 
each time it moves and to update the absolute coordinates of 
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the central positions of all the spheres modeling the 
component members. However, as for the updating of the 
absolute coordinates, in order to make the calculation 
efficient, the updating may be effected with respect to only 
the spheres that are subject to collision detection. 

Thus, stored in the sphere model memory 32 are the 
central positions Pre* of the spheres as viewed from the 
reference coordinates concerning the component members and 
the central positions Pabs of the spheres as viewed from 
their absolute coordinates at the present time. 

Next, the operation proceeds to Step 114 to execute the 
computation of collision detection through the following 
procedures. 

in Step 114, the detection of collision between the 
spheres is performed hierarchically in the order of the 
large spheres, medium spheres, and small spheres. If it is 
determined in Step 116 that collision is present among the 
spheres in the lowermost rank (small spheres) , the 
operation proceeds to Seep 118 in which the occurrence of 
collision and a colliding portion are determined and 
displayed on the basis of the central positions of the 
mutually colliding small spheres. Then, in Step 120. the 
r obots and the work environments in a colliding state are 
displayed, thereby completing this program. 
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The procedures of hierarchical detection using the 
large spheres, medium spheres, and small spheres in Step 114 
will be shown below. 

Step 1: As shown in Fig. 9(a), large spheres 14a, 14b 
are checked, and if there is any collision, Step 2 is 
executed. If there is no collision, the detection is 
completed. Accordingly, until the components members 
approach each other to a certain extent, collision detection 
of large spheres is first carried out, so that the 
computation time is extremely short. 

Step 2: As shown in Fig. 9(b), the detection of a 
collision between one large sphere 14a and medium spheres 
15bl - 15bn included in the opposite large sphere 14b is 
executed, and the colliding medium spheres 15bl, 15b2, 15b3 
are extracted. Conversely, the detection of a collision 
between the large sphere 14b and medium spheres 15al - 15an 
included in. the opposite large sphere 14a is executed, and 
colliding medium spheres 15al, 15a2 are extracted. If there 
is no colliding medium sphere, it is determined that the two 
component members do not collide with each other, so that 
the computation is suspended. 

Step 3: As shown in Fig. 9(c), collision detection with 
respect to the extracted medium spheres 15bl, 15b2, 15b3, 
15al, 15a2 is carried out, the mutually colliding medium 
spheres 15bl, 15b2, 15al are extracted, and Step 4 is 
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executed. On the other hand, if there is no mutually 
colliding medium sphere, a determination is made that the 
two component members do not collide with each other, and 
the detection computation is suspended. 

Step 4: As shown in Fig. 9(d), the detection of a 
collision between one colliding medium sphere 15b2 and small 
spheres 16all - 16alni included in the opposite medium sphere 
15al is carried out, and the colliding small spheres 16all, 
16al2 are extracted. . Conversely, the detection of a collision 
between one colliding medium sphere 15al and small spheres 
16b21 - 16b2n 2 included in the opposite medium sphere 15b2 is 
carried out, and the colliding small spheres are extracted, 
and an ensuing Step 5 is executed. In addition, if there is 
no colliding small sphere, collision determination between the 
medium sphere 15bl and the small spheres 16all - 16alni 
belonging to the opposite medium sphere 15al is similarly 
carried out. When no colliding small sphere is detected, 
collision determination is similarly executed with respect 
to the other mutually colliding medium spheres, and if there 
ceases to be no mutually colliding medium sphere, a 
determination is made that the two component members do not 
collide with each other. 

Step 5: As shown in Fig. 9(e), detection is carried out 
among the extracted small spheres 16all, 16al2, 16b21, 
16b22, 16b23, and the. mutually colliding small spheres 
16all, 16b21 are extracted. In this case, a determination 
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is made that the two component members collide with each 
other at portions of the small spheres Wall, 16b21. On the 
other hand, if there is no mutually colliding small sphere, 
the process returns to the step of extracting other mutually 
colliding medium spheres. 

in the final analysis, when mutual collision between 
small spheres in the lowermost rank is detected, a 
determination is made that there is collision, and the 
positions of those small spheres are determined to be the 
colliding portions. When there is no mutual collision 
between small spheres, processing for other mutually 
colliding medium spheres in an upper rank is executed, and 
if no mutually colliding medium sphere exists, it is finally 
determined that there is no collision. Accordingly, the 
tree structure shown in Fig. 8 is retrieved along branches 
where collision are likely to occur, and by determining the 
mutual collision of all the small spheres in a uniform 
manner, the time for collision determination can be 
shortened by a substantial degree. 

The collision determination of a sphere is carried out 
by determining whether or not the following formula can be 
met if it is assumed that the radii of two spheres are n, 
r 2 and their central positions P x , P 2 , respectively; 

r,+ r^ II P,- Pa II 
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If the above formula is met, it is assumed that the two 
spheres collide with each other. 

Through the above -described hierarchical detection of 
the large, medium, and small spheres, it is possible to 
effectively narrow down the portions of occurrence of 
collision and to effect collision detection rapidly and with 
ease 0 

If it is determined in Step 116 that collision does not 
take place between the spheres in the lowermost rank, it 
means that collision does not take place between the 
component members. As a result, the process proceeds to 
Step 122 in which a determination is made as to whether or 
not a computation has been made concerning collision 
detection with respect to the combinations of all the 
component members. If the computation has not been 
completed with respect to the combinations of all the 
component members, the process returns to Step 114, and the 
detection of collision between the component members is 
executed in a similar manner. On the other hand, when the 
computation of collision detection for the combinations of 
all the component members has been completed, the operation 
proceeds to Step 124 in which a determination is made as to 
whether or not the computation of collision detection has 
been completed. for all the designated objects. If it has.- 
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not been completed, a determination of collision detection 
is similarly -made between other objects* 

If it is determined in Step 124 that the computation of 
collision detection has been completed for the combinations 
of all the designated objects, the operation proceeds to 
Step 126, and the configuration of the robot is computed on the 
basis of joint angles stored in the joint. angle memory 33 at 
that time. The robot in that configuration and the work 
environment are displayed. Then, the operation proceeds to 
Step 128 to determine whether or not all the motions of 
movement have been completed. If all the motions have not 
been completed, the operation returns to Step 110 in which the 
aforementioned collision determination processing is 
repeatedly executed with respect to an ensuing point of 
movement. On the other hand, if it is determined that all the 
motions have been completed, this program ends. 

As described above, the apparatus in accordance with 
the present invention is capable of readily meeting the two 
conditions of accuracy and computing speed that are 
required, so that the apparatus is effective particularly 
when high-speed .collision detection is effected at the time 
of, for instance, a rough motion of a robot. 

In addition, the apparatus in accordance with the 
present invention can model members having any 
shape with the same ^ accuracy , and is a highly 
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versatile apparatus which is applicable to both actual 
robots and off-line simulators, 
fionnnri Embodiment 

A description will now be given of a second embodiment 
of the present invention. 

This embodiment is so designed as to automatically set 
the number of ranks of a sphere model and the radii of 
spheres in each rank in such a manner that the efficiency 
of searching portions where collision occurs is maximized by 
taking the size of an object, the radius of the smallest 
sphere, etc. into consideration. A description will be 
given hereinunder of only those aspects that differ from the 
first embodiment described above. 

In a hierarchical sphere model generating means B, by 
providing a radius n of the largest sphere enveloping an 
object, a radius rn of the smallest sphere determining the 
accuracy of collision detection, and a ratio of radius pr 
between an upper sphere and a lower sphere, the depth of 
ranks (number of ranks ) n and a radius ri of a sphere in 
each rank are respectively calculated by the following 

Formulae (1) and (2) : 
losr. - Iogr B 



n = 



+ 1 •••(!) 



logp , 

where n is an integer by counting fractions over 1/2 as one 
and disregarding the rest. 
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r, i (n-i)/(n-l) 
ri =r.xi I •••(2) 



I n 



where i = 1, 2, n. 

Here, the process of deriving Formula (1) will be shown 

below. 

If the radius of a sphere in each rank is assumed to 
be n, a volumetric ratio pv between an upper sphere and a 
lower sphere (radius ri + i) can be expressed by the 
following Formula (3) : 
4 



— — -ITi 3 

3 rr, 

p» = ■ 

4 

• n ' r ,*i 3 

3 



1 r i + , J 



(3) 



If it is assumed that p v is fixed in each rank , the 
relation between the radius ri of the largest sphere and the 
radius r n of the smallest sphere can be expressed by the 

following Formula (4) : 

4 4 

3 = r « 3 • p, '"" •••(4) 

3 3 
Here, if it 'is assumed that a ratio of radius between 
an upper sphere and a lower sphere is p r , since /5» = p 
on the basis of Formula (3), Formula (4) can be expressed as 
the following Formula (5) : 
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r, s =r„ s - /),"-" 

By taking a logarithm of the two sides of Formula (5) , 
Formula (1) can be obtained. 

In addition, the relation of the following Formula (6) 
exists in the light of Formula (5) : 

Therefore, Formula (2) can be derived from Formulae (5) and 
(6) . 

in the above description, by fixing the volumetric 
ratio Pv between an upper sphere and a lower sphere, i.e., 
by providing a relationship that a fixed number of lower 
spheres are included in an upper sphere, it is possible to 
unformalize the number of lower spheres possessed by each 
sphere in each rank as a whole. Accordingly, it is 
possible to set the number of ranks ranging from the 
largest sphere to the smallest spheres and the number of 
spheres in each rank optimally in terms of searching 
efficiency. 

Furthermore, even if a ratio of area p, = (r, / ri.i) ! 
between an upper sphere and a lower sphere is fixed, it goes 
without saying that the relationship in which the ratio of 
radius p r between an upper sphere and a lower sphere is fixed- 

is applicable. 

It should be noted that the ratio of radius p r . which 

is set in correspondence with the size and shape of 

an object, is set to approximately 2 in this embodiment. 
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Using the number of ranks n and the radius r* of a 
sphere in each rank that are determined as described, a 
sphere model of an object is generated as described below. 

Step 1: A rectangular parallelepiped Rec 1 enveloping 
an object and a sphere Sph enveloping that rectangular 
parallelepiped Rec 1 are generated. (hierarchical level k = 

1) 

Step 2: The hierarchical level k is given by k » k + 
1, and a rectangular parallelepiped Rec k-1 is divided by 
cubic cells inscribing a sphere having a radius r k (i.e., 
cubes having an edge ^2r k ) . Here, since the cubic cells are 
arranged in such a manner that the edges of the rectangular 
parallelepiped Rec k-1 and the edges of the cubes agree with 
each other, the cubic cells, in many cases, overlap with 
adjacent cells, as shown by hatched portions in Fig. 10(a). 
These overlapping portions are deleted, as will be described 
later, and are incorporated as rectangular parallelepiped 
cells Rec k. j , and Step 3 is executed with respect to all 
these cells (j = 1, 2, ...) 

Step 3: A check is made as to whether or not the 
sphere enveloping the rectangular parallelepiped cell Rec k, 
j intersects a surface of the object. If it does, that 
sphere is added to the data of the sphere model, and if k < 
n (i.e., the hierarchical level k is not the lowermost rank 
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level) , Step 2 is further executed with respect to a 
rectangular parallelepiped Rec k + 1. 

At this juncture, an explanation will be given of the 
deletion of the overlapping portions of the cubic cell . 

As described above, in each hierarchical level, 
overlapping portions are added preferentially in the order 
of generation of lower spheres (i.e., lower cells), and a 
cell of a lower priority is defined as a rectangular 
parallelepiped cell excluding overlapping portions. Namely, 
in Fig. 10(b) , in a case where the cubic cell Rec k-1 is 
divided into rectangular parallelepiped cells Rec k,l • Rec 
k,9 by nine spheres Sph k,l - Sph k,9 having the radius r k , 
the cubic cell Rec k,l is determined in such a manner as to 
inscribe the first sphere Sph k,l, and, with respect to the 
ensuing sphere Sph k,2, a portion in which portions 
overlapping with the cubic cell Rec k,l are excluded in a 
cube inscribing the sphere Sph k,2 is defined as the 
rectangular parallelepiped cell Rec k,2. Thereafter, a 
similar operation is effected consecutively with respect to 
spheres Sph k,3 to Sph k,9, and the rectangular 
parallelepiped cells Rec k,l to Rec k,9 that are 
respectively free of overlapping portions are defined. 
Then, in a case where a lower sphere Sph k+1, i is generated, 
since the aforementioned rectangular parallelepiped cells 
Rec k,l to Rec k,9 are divided in the same manner as 
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described above, the overlapping of spheres Sph k + l,i 
generated at overlapping portions is eliminated, so that the 
number of sphere data items can be reduced to a minimum, 
^s, at the time of describing (modeling) the surfaces of 
an object, the number of spheres in each rank can be 
reduced to a necessary minimum, so that the searching 
efficiency at the time of collision detection does, not 
decline. 

A description will be given hereinunder of a recursive 
algorithm whereby a sphere collision computing means B 
conducts collision detection hierarchically with respect to 
a hierarchical sphere model in which the number of ranks of 
objects X, Y generated as described above are n x , n y . 
Although this algorithm can be applied to a case where the 
aforementioned numbers of ranks are not equal (n x * n y ) , 
this algorithm is basically identical with that of the first 
embodiment. It should be noted that by "return true/false- 
referred to in the following steps is meant to return 
true/false to an immediately preceding step. 

Step 1: A mark indicating a possible collision is 
attached to respective sphere data (a flag is set to 1) with 
respect to the uppermost spheres (hierarchical level k = 1) 
of the two objects X, Y, and Step 2 is then executed. If 
the result of true is obtained in Step 2, it is assumed that 
the objects X and Y are colliding with each other. If not 
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(if the result of false is obtained) , it is assumed that the 
objects X and Y are not colliding with each other. 

Step 2: Step 3 is executed with respect to all the 
combinations of spheres that respectively belong to the 
objects X, Y and are subject to detection. If the result of 
Step 3 is true, true is returned. In addition, if there is 
no combination which becomes true, false is returned. 

Step 3: If the mark indicating a possible collision is 
attached to both sphere data belonging to the objects X, Y 
in one combination, collision detection is conducted for 
their spheres. If not, false is returned. If it is found 
as a result of the detection that the spheres are colliding, 
Step 4 is executed with respect to those two spheres. If a 
collision is not taking place, false is returned. In 
addition, if the result of Step 4 is true, true is returned 
and, if false, false is returned. 

Step 4: If the two spheres are of the lowermost level 
(n x , n Y ), a determination is made that the objects X and Y 
are colliding with each other, and true is returned. If 
not, if either one of the spheres belonging to the object X 
or Y is of the lowermost level, Step 5 is executed, while, 
if neither of the spheres is of the lowermost level, Step 6 
is executed. If the results of Steps 5 and 6 are true, true 
is returned and, if -false, false is returned. 
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Step 5: Collision detection is carried out with 
respect to all the combinations between a lowermost -level 
sphere belonging to either one of the objects X, Y on the 
one hand, and a sphere in a rank one level below a sphere 
which belongs to the other object and is not of the 
lowermost level on the other. If a collision is present, 
Step 4 is executed. If no colliding sphere is found to 
exist, false is returned. If the result of Step 4 is true, 
true is returned and, if false, false is returned. At this 
stage, all the marks are cleared by resetting the flags (the 
flags are set to 0) , so that the operation can be 
immediately restarted beginning with Step 1 for the next 
detection of collision between objects. 

Step 6: The detection of collision between spheres is 
conducted with respect to all the combinations of one sphere 
belonging to the object X on the one hand, and a plurality 
of spheres in a rank one level below a sphere belonging to 
the object Y. If a collision is present, a mark is attached 
to data on spheres in a rank one level below a sphere 
belonging to the object Y. If no sphere with the mark 
attached thereto 'is present, false is returned. A similar 
processing is conducted to all the combinations between one 
sphere belonging to the object Y on the one hand, and a 
plurality of sphere's in a rank one level below a sphere 
belonging to the object X. Thus, spheres that have the 



possibility of colliding with upper -level spheres are 
selected by gradually lowering the hierarchical level with 
respect to the spheres of the object X and the spheres of 
the object Y. Then, if a sphere with the mark attached 
thereto is present, Step 2 is carried out with 
respect to all the combinations. If the result of Step 2 is 
true, true is returned and, if false, false is returned- At 
this juncture, all the marks are cleared (the flags are set 
to 0) in the same way as Step 5. 

Next, the procedures of processing by CPU1 for 
determining a collision according to the above-mentioned 
algorithm will be described with reference to Figs. 12(a) 
and (b). 

In Figs. 12(a) and (b), ranks of the present detected 
pair of spheres (iX, jY) for objects X and Y are defined as 
present searching ranks (i, j). Namely, when the collision 
computation between a parent sphere iX and one rank lower 
spheres belonging to a parent sphere jY is executed, the 
present searching ranks (i, j) are defined as the ranks to 
which the parent spheres iX and jY belong respectively. The 
present searching pair of spheres (iX, jY) are defined as 
the presently noted parent spheres iX and jY. 
(a) in case where the number of ranks is the same between 
hierarchical spheres X and Y: 

The processing ..of Steps 200 to 226 and 250 tc 258 shewn 
in Fig. 12(a) leads to a conclusion concerning the presence 
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of collision between two objects X and V. 

—ly. if the Steps 202' to 224 are repeated without 
branching, a branch for searching colliding spheres 
stretches toward the lower ranKs by the shortest process 

v *«r. v On the other hand/ 
with respect to both of spheres X and *. ^ 

if the branching occurs, the searching branch returns to 

upper ran*, stretches horizontally there, and goes to the 

lower rank again. 

For example, in Step 208, if it is determined that 
spheres (IX, <» do not collide with each other, the 
needing returns to Step 202 and then the other unseated 
spheres («. JT, are generated in Step 20,. In Step 2!6 or 
220 if it is determined that there is no collision between 
. parent sphere and child spheres belonging to the other 

., »-,■> search toward the lower 
parent sphere, it is unnecessary to search 

u c Therefore, in this case, the 
rank from the parent spheres. Theretcr 

i-u«« *-hP other unsearched 
proceeding returns to Step 202 and then the 

spheres <iX, jY) are generated in Step 204. 

. , Ll . „ a ii soheres belonging to the 
When it is determined that all sphere 

present searching ranK U, J> in ^ich collision flags are 
on have been searched, the proceeding turns to Step 250. In 

u^i-k^t- the present searching 
Step 250, it is determined whether the pr 

u m i) or net- When the 
rank (i, j) is the uppermost rank 

• '- • -r. M n the present searching rank 
result of determination is NO, the pre 

{i , j, is raised to .one rank higher in Step 254. In 

cpflrchinq rank in the 
. step 256, the data of the present searchi g 
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et-ored in Step 222 is restored 
upper rank which has been stored 

„ ina returns from the lower to the upper 
when the proceeding return 



rank. 



, he res ult of determination is *ES, 
In Step 250, when the result 

that the uppermost rank spheres do not colli* 
it means that u PP ^ x an(J 

each other, and therefore it » 

v „ not collide with each other in Step 258. 

hano when b oth of the colliding spheres 
On the other hand, when 
. d „ are the lowermost spheres in Step 210, xt 
iX and 3* are tne collide with each 

concxuaea in St ep 2» tn« ejects X ana , coU 

other. ^nks is diffe rent 

the number of ranKs 
(b) m the case where the 
Ltween hierarchical spheres X and 

Steps 200 to 22 4 and 2 50 to 253 shown in ,ig. -(a) are 

• c ^ nresent searching spheres 

ex ccc t ca ..til an, cne c, th. present 

t », e icwerr.es t rank. " 
, ;v iYl reaches wi. ^ 

(ix» J 1 ' LV . ,.„|( in Step 

■ s th e lowermost rank in ou v 
that one of the spheres xs xn the 

-Steps 230 to 233 shown xn „ the 

the searching branch for the other sphere 

rank in Step 280, when the lowermost spher 
lower ranK. ^ ^ L an(j thc . 

oresent searching spheres (xX, 3 Y) 

P ... m ^searched spheres (L, k.1) . 

cohere is defined as M # unseat 
opposite sphere rank 

enerated by selecting the sphere L and 
are generated y one 

hGre belonging to the opposite sphere 
lower sphere bei° y accordance with 

c„na sphere » • »«!.«. 9 

the child sphere). 
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itis determined whether a child sphere k« 
In Step 292, it is dec 
„ the Xast o« tt . spheres hanging to a parent s h 

fc . m Then, when it is determined that 
with the parent sphere M. TM 

. a nk 1 in Step 294, the other spheres 
a rank i is equal to a rank hrf . ter the 

^ a \) are generated after cne 
belonging to the same ranks 

. »o step 202. When the rank i is not 
proceeding returns to Step <■» 

«. rank J the sphere belonging to the parent 
eaual to the ranK 3# tnc 

equdJ. *w v-aicpd to one ranK 

sph ere M of the present searching rank is raised t 

v, in Step 296. In Step 298, the data stored inj 
higher in Step searching rank. 

Step 286 is restored as the updated present 

k onlv the possible colliding spheres 
As mentioned above, only the po 

, rar .ks thus much increasing 

are searched toward the lower ranks, 

the searching speed. 

Tne sphere collision computing nveans for 

„ of Figs . 12 <a> and (b) may comprise the following 

procedures of Pigs . ^ ^ 

_ pans for determining the coiiif 

m oh oair of unsearched spheres 

(a) means for selecting each pair 

c marching spheres, said 
for the two objects among present searchi g P 

„„ or one sphere belonging to a 
p air belonging to the same rank on P 

. „„ k a »a the other belonging to a ranr. 
lowermost rank colli sion between . 

the lowermost rank, £or determining the 

d pair o £ spheres, and f or octputting colliding pair o £ 

" r J- searching colliding pair oC spheres in a 

spheres or furcne ^ 

rank Higher rank than the present searching 
one rank nig** ... h 
Vision is searched with respect to all pa- o 
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spheres ; and 

(b , m eans for determining the collision between one 
sphere of said outputted colliding pair of spheres and a 
plur aUtv of spheres in a one ran* iower ran, belonging to 
th e other sphere of said outputted pair of spheres, and or 
detecting and storing coUiding spheres a.ong said piurality 
o£ spheres, or further searching coUiding pair o E spheres 
ln . one ran, higfcer ran, than the present searching ran, 

, . • i. u. rpooect to all of said 
when no collision is searched with respect 

plurality of spheres. 

an example shown in Fig . 11 # a 
Referring now to an example 

ascription will be given hereinunder of the procedures of 

searching spheres that have a coilision by 

using the above-described algorithm, rig. 11 shows 

w^t- v are exoressed as 
case in which the object X and the object . 

• *.vi t-he former having five 
a hierarchical spheral ,..el illuJtratos 
ranks and the latter having three ranKs . 

t he relationship between the respective ranKs ranging from 
an uppermost sphere ,a sphere , in the case of the object X 

^ • vt to iov;ernost 
end a sphere y in the case o£ the object V) 

„ in the case of the object 
spheres (spheres xllll »— in the 

m,. case oE the object V] in 
x and spheres ylL ynn in the case 

th e same way as fig. S, Xt should be noted that, in he 
rawing, the respective circles are shown unrelated to . 

v in addition, 

the radii of the spheres in each rank . 

• ; ^iratG the procedures 
numerals (1) to (9, in the drawing indicate 
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of detecting collision between the spheres o£ the objects 
and correspond to the items of description that follow. 
Furthermore. by "collision detection of (x. y.» is meant to 
conduct the detection of collision between the sphere x and 
the sphere y. 

First, in executing the detection of collision between 
the objects X and V. a marx indicating a possible collision 
is attached to x and y. respectively. 

,1, Since a collision is found to exist as a result of 
the collision detection of (x. y) . it is determined that x 
and y are in a colliding state. 

,2) collision detection is conducted for all the 
combinations between x found to be in a colliding state on 

t-Viat- are of a lower level, 
the one hand, and yl, y2 that are or 

i.e., (x, yl), (x, y2) <«.*»,. Since a collision is 

found to exist between x and yl and between x and y2 as a 
result of the detection, the mark is attached to yl and y2. 

(3) Similarly, the mark is attached to xl, x2 that are 
found to be in a colliding state as a result of conducting 
collision detection for all the combinations between y and 

xl, x2 xm of a lower level. 

{4 ) As a result of conducting collision detection for 
all the combinations of spheres with the mark attached 
thereto, i.e., (xl.-yl) . (xl. y2) . (x2, yl) . <* 2 < * 2 > ' * 
collision is found to exist between xl and yl, so that xl 
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and yl are determined to be in a colliding state. Namely, 

collision detection is not carried out between x3 xm 

and y3 yn that are not provided with the mark. 

(5) in the same way as (2) , the mark is attached to yll 
and yl2 that are found to be in a colliding state as a 
result of conducting collision detection for all the 

combinations between xl on the one hand, and yll. yl2 

yln of the level lower than yl on the other, with respect to 
xl, yl that are found to be in a colliding state. 

(6) in the same way as (3), the mark is attached to xll 
and xl2 that are found to be in a colliding state as a 
result of conducting collision detection for all the 

combinations between yl on the one hand, and xll, xl2 

xlm of the level lower than xl on the other, with respect to 
xl, yl that are found to be in a colliding state. 

(7) It is determined that xll, yll are in a colliding 
state since a collision is found to exist between xll and 
yll as a result of collision detection of all the 
combinations of the spheres with the mark attached thereto, 
i.e., (xll, yll), (xll, yl2), (xl2, yll), (xl2, yl2) . 
Incidentally, since yll is a sphere of the lowermost level 
of the object Y, yll is treated as the object sphere for 
subsequent detection with respect to the object Y. 

(8) With respect to xll, yll found to be in a colliding 
state, collision detection is consecutively conducted with 
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respect to all the combinations between yll arid xlll. xll2, 
xllm of the level lower than xll. Since no collision 
exists between xlll and yll, collision detection is then 
carried out for (xll2, yll). As a result, since a collision 
is found to exist between xll2 and yll, xll2 is determined 
to be in a colliding state, and the objects for detection 
are shifted to spheres of the level lower than *112 by 

bypassing xll3 . 

(9) Since no collision is found to exist between yll 
and X1121 of the level lower than xll2, collision detection 
is. then conducted with respect to (xll22, yll). As a 
result, since it is found that a collision is taking place 
between xll22 and yll, xll22 is determined to be in a 
colliding state. Since xll22 is a sphere of the lowermost 
level, processing is ended at this juncture, and collision 
detection is not conducted with respect to a next sphere 
xll23 irrespective of the presence of a collision. 

Thus, it is immediately determined that the object X 
and the object Y are colliding with each other at the 
portions where the sphere xll22 and the sphere yll are 
present. 

However, in a case where it is desired to ascertain the 
presence of collision with respect to all the portions of an 
object, it suffices- if collision detection is conducted with 
respect to the combinations between yll and all of the 
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spheres x113, x11m which were excluded from the 

objects of detection in item (8). 

As described above, since collision detection is 
conducted with respect to only the spheres provided 
with the mark indicating a possible collision by means 
of detection for combinations of a sphere belonging to 
one object and an upper-level sphere belonging to the 
other object, it is possible to very much reduce the 
number of combinations of spheres subject to detection. 
Accordingly, it is possible to enhance the efficiency 
of collision detection between objects by a remarkable 
degree. 
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CLAIMS 

1. A method of detecting collisions between objects 
at least one of which is moving, which comprises 
representing the surface of each object by spheres 
arranged in a heirarchy of ranks of spheres from the 
largest which encloses the object to the smallest 
spheres, spheres in a given rank all being of the same 
size, and checking whether at increments of relative 
movement of the objects any sphere of one object 
intersects a sphere of another object, the checking 
starting with the largest spheres and progressing rank 
by rank to the smallest spheres via the spheres which 
are found to intersect, collision being held to be 
detected when one of the smallest spheres of one object 
intersects with one of the smallest spheres of one of 
the other objects, 

2. An apparatus for detecting the collision of 
objects including at least one moving object, 
comprising: 

face information storing means for storing face 
information describing the surfaces of each of said 
objects? 

hierarchical sphere model generating means for 
modeling the surfaces of each of said objects by 
hierarchically covering said surfaces with spheres 
having a plurality of radii on the basis of said face 
information; 

sphere model storing means for storing the 
positions of said modeled spheres generated; 

sphere position updating means for updating the 
position of each of said modeled spheres having said 
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plurality of radii with respect to said moving object 
in correspondence with the movement of said moving 
object and outputting said updated position to said 
sphere model storing means; and 

sphere collision computing means 

for executing procedures in which mutually 
colliding ones of said spheres are detected on the 
basis of the positions of said modeled spheres 
concerning two of said objects generated at an 
arbitrary time and stored in said sphere model storing 
means, and colliding spheres among spheres belonging to 
said mutually colliding spheres and having a smaller 
radius are further detected with respect to only said 
spheres determined to collide with each other, said 
procedures being executed hierarchically and 
consecutively starting with spheres having a large 
radius toward spheres having a smaller radius, and 

for determining the collision of said two objects 
with each other when finally mutually colliding spheres 
having the smallest radius are present, thereby rapidly 
and accurately detecting the risk of collision of the 
objects. 

3. Apparatus according to Claim 2, wherein said 
hierarchical sphere model generating means comprises 
means for modeling the surfaces of each of said objects 
by hierarchically covering said surfaces with spheres 
having a predetermined number of ranks and having a 
different radius for each rank on the basis of the face 
information. 

4. Apparatus according to Claim 2 or Claim 3 wherein 
said hierarchical sphere model generating means 



45 



comprises means for determining radii of spheres in 
medium ranks between an uppermost rank sphere 
circumscribing the objects and a radius of the 
lowermost rank smallest sphere which determines a 
predetermined accuracy of a collision detection, and 
hierarchically arranging the spheres so that the larger 
spheres include the smaller spheres and the surfaces of 
the objects. 

5. Apparatus according to Claim 3 or Claim 4 wherein 
said hierarchical sphere model generating means 
comprises means for determining radii of spheres in 
each rank and the number of ranks on the basis of a 
radius of an uppermost rank sphere circumscribing the 
objects, a radius of a lowermost rank sphere 
determining an accuracy of a collision detection and a 
ratio of radius between an upper rank sphere and a 
lower rank sphere. 

6. Apparatus according to Claim 5 f wherein said 
hierarchical sphere model generating means comprises 
means for determining said radii of spheres in each 
rank covering the surfaces of the objects and the 
number of ranks n on the basis of the radius R-j of the 
uppermost rank sphere, the radius r n of the lowermost 
rank sphere and the ratio of radius Pr by the following 
formulae: 

log^ - logr n 

n = +1 

logp r 

(n is an integer by counting fractions over 1/2 as one 
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and disregarding the rest); and 
r 



r 1 ■ r n x 



•1 



L r n 



<n-i)/(n-1) 



7. Apparatus according to Claim 3, 4 or 5 wherein 
said hierarchical sphere model generating means 
comprises the following means for modeling the surfaces 
of the objects: 

(A) means for generating a rectangular 
parallelepiped-shaped envelope cell enveloping the 
object on the basis of the face information outputted 
from said fact information storing means and generating 
an uppermost rank sphere circumscribing said envelope 
cell; 

(B) means for determining the radii of spheres in 
medium ranks on the basis of the radius of the 
uppermost rank largest sphere and the radius of the 
lowermost rank smallest sphere; 

(C) means for extracting a radius in the order of 
larger to smaller radii among said determined radii of 
said medium rank spheres and said radius of the 
lowermost rank sphere; 

(D) means for dividing a cell inscribing an upper 
rank sphere having the larger radius into a plurality 
of cubic cells inscribing the spheres having said 
extracted radius; and 

(E) means for generating spheres circumscribing 
said divided cubic cells respectively , extracting only 
such spheres that intersect with the surfaces of the 
objects among said generated spheres, and generating 
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said extracted spheres as lower rank spheres with 
respect to said upper rank sphere. 

8. Apparatus according to Claim 7, wherein said 
hierarchical sphere model generating means comprises 
means for dividing said cell inscribing the upper rank 
sphere having the larger radius into said plurality of 
cubic cells having overlapping portions between the 
adjacent cells. 

9. Apparatus according to Claim 8, wherein said 
hierarchical sphere model generating means comprises 
means for dividing each cell in which said overlapping 
portions are deleted into a plurality of smaller cubic 
cells inscribing the spheres in a lower rank than that 
of the spheres having said extracted radius and having 
overlapping portions between the adjacent cells. 

10. The apparatus according to any one of Claims 2 to 
9 wherein said sphere collision computing means 
comprises the following means for determining the 
collision of said two objects: 

(a) means for selecting each pair of unsearched 
spheres for the two objects among present searching 
spheres, said pair belonging to the same rank or one 
sphere belonging to a lowermost rank and the other 
belonging to a rank other than the lowermost rank, 
determining the collision between said pair of spheres, 
and outputting colliding pair of spheres or further 
searching colliding pair of spheres in a one rank upper 
rank than the present searching rank when no collision 
is searched with respect to all pairs of such spheres; 
and 



(b) means for determining the collision between 
one sphere of said outputted colliding pair of spheres 
and a plurality of spheres in a one rank lower rank 
belonging to the other sphere of said outputted pair of 
spheres, and detecting and storing colliding spheres 
among said plurality of spheres, or further searching 
colliding pair of spheres in a one rank upper rank than 
the present searching rank when no collision is 
searched with respect to all of said plurality of 
spheres . 

11. A method as claimed in Claim 1 substantially as 
specifically described herein with reference to the 
accompanying drawings. 

12. Apparatus as claimed in Claim 2 substantially as 
specifically described herein with reference to the 
accompanying drawings. 
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